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ABSTRACT 


Compliant morion occurs when the manipulator position h constrained by 
the task geometry. Compliant motion may be produced either by a passive 
mechanical compliance built in to the manipulator, or by an active compliance 
implemented in the control servo loop. The second method, called force control, 
is the subject of this report. In particular, this report presents a theory of force 
control based on formyl models of the manipulator and the task geometry. The 
idcaf effector is used to model the manipulator, and the task geometry is modeled 
by the ideal surface, which is the locus of all positions accessible to the ideal 
effector. Models arc also defined for the goal trajectory, position control, and 
force control. 

These models are useful in two respects. First, the model of force control 
provides a precise semantics for force control primitives in manipulator 
programming languages. The model defines a simple interface between the 
manipulator and the programmer, isolating the programmer from the fundamental 
complexity of low-level manipulator control. 

Second, the formalism provides a method of synthesizing force control 
programs for compliant motion, A force control program is modeled as a set of 
equation in the components of manipulator velocity (angular velocity) and force 
(torque). The task geometry constraints can be modeled similarly. The control 
program synthesis problem is to construct a program whose equations, when 
combined with the task geometry equations, have a single unique solution equal 
to the goal trajectory, We show that to obtain good performance in the presence 
of planning model error* it is also desirable that these two sets of equations be 
orthogonal and non-redundant. 
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l Introduction 
U Overview and Motivation 

A computer-controlled mechanical manipulator is a tool of fantastic 
potential, but sn far the applications have been disappointing both in number and 
in sophistication. Current applications of industrial manipulators are for the most 
part limited to large-motion tasks such, as material transfer, spray-painting, and 
spot-welding, These operations are. accomplished by moving along a predefined 
sequence of points without any variation from one cycle to the nest- This 
me (hod is effective in many cases, but a variety of potential applications, notably 
automatic assembly* require more sophisticated use of the manipulator. 
Successful development of such applications awaits progress in several aspects of 
manipulation including compliant motion, manipulator programming languages, 
and automated task planning. This report will focus on the first of these* 
compliant motion. 

'"Compliant motion' 1 occurs when the position of the manipulator is 
constrained by the task. When sliding along a tabletop, for instance, downward 
morion of the manipulator is prevented. Another example is the opening of a 
drawer, where no rotation is possible and translation is possible only along the 
drawer's axis. Compliant motion is an important part of a mechanical assembly 
system* since fitting parts together generally requires motion between objects in 
contact. Ideally these operations should be performed quietly but without 
producing excessive forces at points of contact. 

There are two- primary methods for producing compliant motiom a passive 
mechanical compliance built in to the manipulator* or art active compliance 
implemented in the software control loop, force control . Passive compliance 
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offers some performance advantages, but the force control! method offers the 
advantage of programmability. This allows the manipulator to choose the 
particular form of compliance necessary for the particular application. Using 
force control* a single manipulator can both open a drawer and slide on a 
tabletop without pausing to change hands. 

Various force control systems have been implemented, but development of 
an underlying theory of these systems has been neglected- This report approaches 
such a theory by constructing models of force control and of manipulator task 
geometry. These models can be useful in two way?- First, a force control system 
Can be exhaled according to how well it agrees with the formal model This is 
common in the case of position control, where a control system is judged by its 
^error" — the difference between the desired and actual trajectories. Second, a 
formal model greatly simplifies manipulator programming. Effective programming 
occurs only when the programmer has a thorough understanding of the 
programming language primitives. Hence, the relevant primitives should be 
well-defined, which in the case of compliant motion primitives requires a model 
of force control- 

L2 Position and Force Control 

The development of a model for general force control is conveniently 
approached by discussing models for simpler control modes, pure position control! 
and pure force control . The model for a general force control system will be 
intermediate between these two. 


Pure position control is a transducer whose input is in symbolic form and 







whose output is encoded as the position and orientation 1 of the end-effector in 
some pro-determined coordinate system. Input and output sire just different 
encodings of the same six-dimensional vector function of time p(t). In pure 
position control the user is allowed to completely specify the effector position 

trajectory. Pure force control can be defined In an analogous way_the user 

provides a vector function f{t) which specifies the forces to be exerted by the end 
effector 


Each of these models is appropriate only under particular conditions, which 
can be. deduced from simple mechanical considerations, For example, if pure 
position control is- applied to the problem of sliding a drawer, then the position 
of the end-effector is subject to constraints front the task configuration and from 
the control system simultaneously. Due to the inevitable errors in manipulator 
planning and control* it is unlikely that these simultaneous constraints will be 
consistent. Our model of pure position control wilt not be satisfied in such a 
Case, for the manipulator wilt not be free to follow the desired trajectory. 

This situ a I ion is illustrated by considering the Conceptual extremes. If the 
manipulator tip is buried in an immobile stiff solid substance, then there is no 
positional freedom at all, and pure position control is meaningless, However, the 
manipulator will have complete force freedom, since any force it wishes to exert 
will be "accepted* 1 by the solid. In this instance, pure force control of the 
manipulator is appropriate. Now consider the opposite extreme, with the 
manipulator in free space. The situation is completely reversed. There is no 
force freedom, because there ls no possible source of the required reactive force. 
Since there is no constraint on manipulator position, pure position control is now 


1. From now on the term "position" may be used, to refer to both position and 
orientation, Likewise "force" may refer to both force and torque. 
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indicated. It appears that pure position and pure force control are in some sense 
dual concepts, and that the historical emphasis on position control is the natural 
result of applications which involve very little physical contact. 

Intermediate between the extremes of solid space and free space are 
surfaces. Loosely speaking, a surface is a task configuration which allows only 
partial positional freedom, freedom of motion occurs along surface tangents, 
while freedom of force occurs along surface normals. Neither pure position nor 
pure force control is appropriate in this case, but rather a hybrid mode of 
control, which gives control of effector force along the surface normal and 
control of effector |>osition along the surface tangent. 

To relate these issues to real-world manipulator control systems, consider 
the task of manipulating a round peg in a hole (figure 1.1). The peg + s motion is 
constrained by the hole. Assuming a snug fit, the peg can rotate about its own 
axis or translate up or down along the axis. If a position control system is in use, 
the motion of the peg and the force everted between the peg and hole are 
unpredictable. Any motion commands are very unlikely to satisfy the physical 
constraints, for the program’s model of the task will inevitably contain some 
error, however slight. The effect depends criiically on the details of the control 
servo and on the presence of mechanical compliance in the manipulator. In some 
cases the inconsistency between the program constraints and the task constraints 
will produce large forces between the peg and hole, ultimately disturbing the task 
configuration or even damaging the manipulator. 

If the program may use force and position control simultaneously, the 
insertion tiecomes feasible. The program may specify that the forces and torques 
normal to the surface be zero during the motion. The control system can satisfy 
such a command only by producing small corrective motions that compensate For 
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Figure 1.1. Insertion of a Peg in a Hole, 


the inaccuracies of the position commands [lncrue74J, 

1J Control Strategics and Programming Language Primitives 

Programming is often simplified by constructing the program hierarchically, 
with code at each level written using primitives defined at a lower level, For 
manipulator programming, the lowest level provides the interface with the 
manipulator sensors and actuators. Each primitive at this level constitutes a 
control strategy . i,t. a particular convention for combining input from higher level 
code and from sensors to produce signals for the actuators. With every control 
strategy is associated a set of assumptions on the task configuration, and a 
particular function, often formulated as some aspect of the manipulators behavior 





















to be regulated. Wc have already seen two examples of control strategies — 
pure position control and pure force control. The assumptions associated with 
these control strategies were the absence of physical contact and the presence of 
it* respectively. 

Another control strategy in Common use is the guarded move [Will?;], 
which is used to approach and touch a surface without producing excessive force, 
after contact is made. This is achieved by moving toward the surface slowly 
while closely monitoring a sensor which can detect contact. Guarded move 
control strategies and compliant motion control strategies arc complementary* if 
the two classes are suitably generalized. In chapter two we will present a formal 
definition of surface which includes solid space or free space as well as the locus 
of possible positions of a drawer or of a peg in hole. Compliant motion occurs 
when the manipulator trajectory traverses- such a surface, and a guarded move 
occurs when the manipulator trajectory crosses the junction between two such 
surfaces. Hence a manipulator trajectory can be decomposed into a sequence of 
compliant motions joined together by guarded moves. 

The use of control strategies provides a convenient structure for the 
low-level control system without unduly compromising flexibility. In addition, the 
task state assumptions can be ''compiled" into the control strategy to produce a 
very efficient program. Since each control strategy is used for a particular 
manipulator function and a particular type of task configuration, the control 
strategies must be switched in and out of the control loop by a higher-level 
process. 

There are three primary criteria for a useful control strategy. First, of 
course, is that its function be relevant to the task. Second » that it execute 
quickly, since it is generally executed at least twenty limes per second. Third, 
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ibe resulting behavior of the manipulator must be conceptually simple. This is 
important from a planning and modeling viewpoint In many respects the 
behavior of (he manipulator itscLf will he the must difficult component of the 
task configuration to model, due to its great versatility. The role of the control 
strategy is to mask this complexity from higher levels of code. The Control 
strategy model is the semantic component of a primitive of the manipulator 
programming language, Hence there are two characterizations of the problems 
addressed in this report; the synthesis of control strategies for compliant motion, 
and development of semantics of force control primitives for a manipulator 
programming language, 

1.4 Example and Overview of Control Strategy Synthesis 

Consider again the problem of manipulating a peg in a hole (figure U). A 
program for this task might look like 

MOVE TO D WITH 
BEGIN 

FORCE X 0 
FORCE Y 0 
TORQUE X 0 
TORQUE Y 0 
END 

where D is the goal position of the peg. The Coordinate axes specified by force 
(torque) statements are the co mpliant axes, translation and rotation of x and y in 
some pre-determined cartesian coordinate system. The remaining axes, translation 
and rotation of z, are the non-compllant axes. During execution of the move, the 
non-compliant axes will be position servoed using a trajectory computed from the 
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move statement, while the compliant sues are force servoed using the farce 
(torctue) statements ) As long as frictional forces are negligible, the program Can 
be executed without significant forces between peg and hole, 

A simple observation will assist in formulating a method for synthesizing 
such programs. The pegon-hole has two degrees of Freedom, which we may 
choose to be translation aiong and rotation about the z-axis. The non-compliant 
axes are also z-translation and z-rotation, precisely the same as the degrees of 
freedom.^ This important property leads to a simple method for synthesizing 
force control programs — we simply write a move statement specifying the goal 
j>osition of the end-effector with a force (torque) statement for each axis 
orthogonal to the degrees of freedom, The control strategy synthesis- method 
developed in succeeding chapters is analogous to the method of this example, but 
is appropriate for a very general class of task configurations. This generality is 
obtained by viewing a task configuration in terms of the resulting constraints on 
motion of the manipulator end-effector. 

The main goal of this report is. to formulate in precise terms a general 
method of control strategy synthesis.. The logical structure of the report is 
indicated in figure 1.2. In order to develop the method in a well-defined manner, 
we will deal with abstract models of the task configuration, the manipulator* and 
the goal trajectory- These models arc the components of the ideal domain . The 
models and the mechanics of their interaction are wdl-defined in the ideal 


1. For the present it is necessary to appeal partly to intuition for the meaning 
of this; program, 

2. The choice of degrees-of-fretdom is not the only one possible. For example, 
we might also have chosen the difference between E-translation and z-rotation, 
and the sum of z-translation and z-rotation. In any case, the plane spanned by 
the degrees-offreed om is the same as that spanned by the non-compliant axes. 
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domain;, so the synthesis method may he defined and evaluated in precise terms. 
In the ideal domain, the manipulator is represented by the ideal effector, ait 
object with no physical dimensions, with attributes of position and force only- 
The task configuration is represented by equal ions relating, the components of 
ideal effector force and velocity. These equations are referred to as the natural 
Constraints - A control strategy for the idea! effector is represented in the same 
way, as linear equations on. effector force and velocity, called the artifi cial 
constraints. The goal trajectory gives the. desired ideal effector position as a 
function of tame, which must be consistent with the natural constraints. In the 
ideal domain the control strategy synthesis problem is to find artificial constraints 
which will reproduce the desired goal trajectory given the natural constraints. 

Thc synthesis of real-world control strategies consists of three steps. First, 
the task is modeled as a set of natural constraints in the idea! domain- Second, 
the synthesis method is applied in the ideal domain to obtain a set of artificial 
constraints. Finally, the artificial constraints are transformed into a 
corresponding real-world control strategy. The last step would be accomplished 
by a low-level manipulator control System which enforces the artificial constraint 
equations on the manipulator end^effector. 

A model of the control system which was well-defined only when the ideal 
Surface coincides with the physical surface would be of little use. In actual 
practice, the natural constraints would be obtained from a geometric- model of 
the task environment, the planning model, The ideal goal trajectory will 
therefore lie in the planning model surface, while the actual trajectory must He in 
the real-world surface. Hence, the low-level control system is modeled as a 
projection of the ideal goal trajectory onto the real-world surface- There are two 
appealing choices: project the trajectory along real-world surface normals or 
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along plan nine model surface normals. We will opt for the second alternative: 


The desired manipulator trajectory lying in the real-world 
surface is obtained by projection of the goal trajectory 
along planning mode! surface normals. 


There are many reasons for this choice. The real-world surface normals are 
unknown to the control system, while the planning model surface normals nre. 


The use of planning model surface normals also simplifies planning/programmiiig 


considerably. Given a particular goal trajectory and planning surface, if we 
project the goat trajectory along planning surface normals, the position of the 
manipulator depends only on the displacement between the planning surface and 
the actual surface. However* if the projection is along real-world surface 
normals, the position of the manipulator depends on the orientation of the 
real-world surface as well The difference is illustrated in figure LJ r which 
depicts projections front a planning model surface onto several actual surfaces 




(a) 

p I armed posi tions 


(b) 


* actual positions 


Figure 1-3- Position Projection Along Plan Normals and Real Normals. In (a) 
the planned position is projected onto real surfaces along the. real surface 
normals, til (b), the projection is along planned surface normals. 
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using both methods. 

Furthermore, if the projection is along planning normals, an implementation 
which projects velocities rather than positions will work fine, but if the control 
system projects velocities along real-world normals then the position of the 
manipulator at any time will depend on the entire trajectory history. This 
situation is til unrated in figure 1.4, comparing the goal trajectory with the 
trajectories obtained by projecting velocities along planning normals and; along 
real normals. An error of this sort might go unnoticed in many cases, but some 
tasks are especially susceptible to error of this kind. For instance, if the 
manipulator were scribing a circle on a surface, slight irregularities in the surface 
would prevent the end points of the manipulator trajectory from meeting. 



Figure 1.4. Velocity Projection Along Flan Normals and Real Normals, The 
goal trajectory specifies motion from left to right along the planning surface (a). 
The trajectory velocity is projected onto real surface (b) using planning surface 
normals, and onto real surface (c) using real surface normals. The tick marks 
correspond to the effector position at successive intervals of time. 















Teh summarise, the task configuration and goal trajectory &.re transformed 
into 3 set of natural constraints in the ideal domain. From the natural 
constraints is obtained a set of artificial constraints for the idea] domain. The 
artificial constraints are applied to the manipulator end-effector by a low-level 
manipulator control system. The resulting manipulator trajectory is Judged 
according to how well it satisfies the projeciion criterion. The problem of 
obtaining the artificial constraints from the natural constraints and goal 
trajectory is the subject of chapter two. The transformations between the real 
world and the ideal domain are developed in chapter three, Chapter four consists 
of the concluding discussion and suggestions for further work. 

1.5 Relationship to Previous Work 

This report is directly related to two different areas of manipulation 
research; manipulator force control, and automatic assembly planning- This 
section will briefly highlight previous work in these fields, and their relation to 
the work in this report. 

The earliest computer-controlled manipulator is described in [ErnstblJ. 
Although Ernst’s system had force sensors mounted on the hand* they were not 
used to servo effector force, but to delect contact during a motion. 

[Inoue7L] demonstrated a system which used force control to turn a crank 
and insert a peg fn a hole. For each desired axis of compliance, the user selects a 
manipulator joint — a free joint — (o be force-servoed. Inoue f s force control 
implementation was essentially open-loo# the actuators for the free joints exerted 
a constant torque for the duration of the movement. 
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[Paiil72] implemented compliant motion using the free-joint method, Paul's 
system was also open-loop, but with compensation for forces due to link 
accelerations. Free joint selection was automated; the user specified the direction 
and magnitude of the force to be applied in cartesian space. 

[Silver? 3] implemented a closed-loop free-joint system using a Force-sensing, 
wrist {[Minsky? 2]). A precision assembly task performed using this system is 
described in [Inoue?4j- Free-joint selection was the responsibility of the user* but 
the manipulator joints were permanently aligned with cartesian axes, making the 
choice simple. 

[Mcvins74a] provides a good general overview of force control. Two 
methods, the generalized spring and generalized damper are of particular interest* 
as they readily provide formal models of force control and provide itn interesting 
contrast wnth the force control models of this report. The generalised spring 
method has been realited mechanically [Ncvins77j and the generalised damper's 
implementation in software is considered in detail in [Whitney? 6^ 

fPau|?6] describes a cloosed-loop method of force control, and [Shimano77] 
describes an implementation of a variation of (his- method. The control strategies 
supported by these systems arc very similar to the strategies we will discuss. 

Task level planning has been investigated at Stanford [Fjnkel74, Taylor?b), 
at Edinburgh [Anibkr75], at MIT [La>zano76j, and at IBM lLieberman75|. These 
systems take task specifications expressed as operations on physical objects, and 
attempt to derive an appropriate manipulator program written using control 
system primitives. The last stage of this transformation is to derive the control 
program from manipulator motion specifications, i.c, control strategy synthesis, 
[LozanoTbj and [Taylor7£»] discuss this problem in detail. 
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2, Control Strategy Synthesis in the Ideal Domain 
2.1 Manipulator and Task Models 

The tdea[ domain is a mode] of the real world for which control strategy 
synthesis is particularly simple. In the ideal domain, the "manipulator" is the 
ideal effector, defined to have attributes of position and force only. The ideal 
effector's forte and position are each represented as sin dimensional vectors over 
the reals. The six dimensions correspond to translation and rotation around the 
x-uxi&, y-axis, and z-axis. 

The task configuration is represented by the subset of F 6 consisting of the 
possible positions of the ideal effector, called the jdeal Surface . The ideal surface 
must be connected, and must have a unique tangent space at each point. 1 The 
dimension of the ideal surface may vary from 0 to 6. The tangent space is a 
vector fiat (a vector subspace which has been displaced from the ortgtnj with the 
same dimension as the [deal surface, A few examples of ideal surfaces will 
illustrate their properties. An ideal surface of dimension 0 is a point, 
corresponding to the absence of any freedom of motion. An idea] surface of 
dimension 6 contains all of near the effector position, representing complete 
freedom of motion. Figures 2.1 and 2.2 show ideal surfaces for a peg in a hole 
and for a crank. The six axes of are the three translation components P KP P yr 
P# and the three rotation components $ r and 8 Z The ideal surfaces in 
figures 2.1 and 2,2 may be decomposed into spaces embedded in R^ Otherwise 
displaying these spaces graphically would be very difficult 


1. The spaces described are open connected differentiabie sub-manifolds of R&, 
but the properties we need will be assumed without reference to the 
mathematical theory of manifolds. 
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Figure 2.J. Tdeal Surface ai Centex of Peg in Hole. The ideal surface is the 
plane equal Eo the cross-product of the two lines depicted here. 


Since the ideal effector position lies in the ideal surface at all times, the 
ideal effector velocity will lie in the vector suh&pace parallel to the tangent space. 
This constraint can be expressed as a set of linear equations on the velocity 
coordinates. Similarly, if tangential fortes are neglected, then effector force is 
restricted to be orthogonal to the tangent space, a Constraint expressed as linear 
equations on ideal effector force coordinates. Figure 2.3 depicts the tangent 
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Figuiq 2.2. Ideal Surf ate for Crank. The ideal surface is the cross-product of 
(re spiral on the left with the point on the right. 


Space (dashed Hue) and the parallel velocity space (solid line) for a crank. These 
linear equations in ideal cffecior velocity and force are the natural constraints . 

The gpa| trajectory in the. ideal domain is the desired ideal effector position 
as a function of time, which must lie in the ideal surface. Finally, control 
strategies in the ideal domain, the artificial constraints, are expressed in the same 
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Figure 2.3. Tangent and Velocity Spaces for Crank Surface. The tangent space 
is the cross-product of the dashed line on the left with the point on the right- 
The velocity space is the cross-product of the solid Line with the point. 


form as the natural constraints: equations in components of effector force and 
velocity. The control strategy synthesis problem is to find artificial constraints 
which will produce the given goal trajectory for a given surface. This report 
develops a method for synthesizing the artificial constraints for a very broad 
range of surfaces, but we begin by considering very simple surfaces. The more 
general result is obtained by relaxing some of the restrictions on the surfaces. 

2.2 Zero-Energy Surfaces 

Consider again the ideal surface for a point at the center of a peg in a 
hole, with the hole fixed in space (figure 2-1), The peg is able to translate along 
the z.-am and rotate about the z-axis f but cannot translate along or rotate about 
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the Other axes. Similarly, force abng and torque about the z-axis are zero (if the 
coefficients of friction are zero), while forces and torques for the other axes are 
unconstrained. So the natural Constraints for this task configuration are 

v x = 0 c o 

y y ~ G ^ Wy = 0 

fj = 0 r * 0 

Mi 

where Vjr. Yy represent component} of ideal effector velocity; Uy components 

of angular velocity; f r a component of effeetoi force, and r ; a component of 
effector torque. 

These equations are homogeneous linear equations in the components of 
force and velocity, with the force equations orthogonal to the velocity equations. 
Formally, we define a zero-**r& surface to be an ideal Surface giving a 
consistent set of homogeneous linear equations in the components of effector 
velocity, and an orthogonal set of homogeneous linear equations of effector force. 
These are called zero-energy surfaces since it is impossible for the effector to 
exert a force in I he same direction that it is moving. 

Zero-energy surfaces correspond intuitively to real-world tasks comprised of 
stiff, immobile solids with negligible coefficients of friction. The definition also 
excludes any asymmetry of the constraints with respect to direction. That is, if 
motion is impossible in one direction, it must be impossible in the opposite 
direction, A simple example of a physical configuration violating this restriction 
* s d resting: against the bottom of a hole, illustrated in figure 2.4. In this 
case, translation along the positive e-axis Is possible, but not along the negative 
J^axis, In fact, this configuration cannot be modeled directly as an ideal surface, 
since there is no unique tangent space. The transformation necessary to model 
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Figure 2.4. Peg at Bottom of Hoke. The ideal effectors A and B are rigidly 
attached to 0. 


till* situation is developed in section 2-5. 

The effector velocity and effector force are represented as vectors in a 
six-dimensional vector space over the reals denotes the transpose of v)i 

T = (V* V y V z W, 0 y ^ Z .) T 
f = (f x (y f z fy rp T 

If the constraints on t and f are represented in matrix notation, then for the peg 
in hole example of figure 2 . 1 * we have 

A* = 0 
Bf =0 


where A and R are given by 


(2.1a) 

(2.1b) 
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Equations of the form of 2 .Ja and 2 , 1 b restrict the effector force and velocity to 
lie in vector subspaces, denoted S T and S f respectively. For a wr^nergy 
surface, S T consists of a EE vectors which are orthogonal to every vector in S f> and 
vicK versa. In other words S ? and Sf are orthogon al complements . 


< s i y L = s* (s f >1 - s T 


For the configuration of figure 2 . 1 , S, is the plane, while S f is spanned by 

the r x ! f y and T y a,C5 ’ These two snbspaces are Indeed orthogonal 
complements, 


The artificial constraints have the same form as the natural constraints, 
except that the equal Eons need not be homogeneous There are two Criteria to 

determine whether the artificial constraints will produce the desired goal 
trajectory; 


The combined (artificial +- natural) force constraints must 
be consistent. 

The combined velocity constraints must be non-singular 
with the goal trajectory as the unique solution. 

There are many possible sets of artificial constraints which satisfy these 
conditions. We will focus on Just those which are orthogonal to the natural 
constraints. Ju&l as the natural velocity constraints could be represented as a 
vector subspace S fl the artificial velocity constraints may be represented as a 
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vector flat ((S ¥ >L,t) which is the result of displacing the subspace (S T )-*- from 
the origin by r, tg S r Now, an elementary result of linear algebra is that any 
velocity vector is uniquely represented as the sum of a vector in S y and a vector 
in (S ? )l that is* F 6 is the direct sum of S T and (S y )J-. The component of 
velocity along is determined by the task geometry to be 0. The 

component along S T is equal to the goal trajectory velocity, but by construction, 
it is also the displacement v associated with the artificial constraint velocity flat 
{(S^.t). Hence the artificial velocity constraints are completely determined by 
the natural constraints and the goal trajectory. 

The situation is not as clear for the force constraints. The effector force is 
uniquely represented as the sum of a vector in Sj and a vector in ($f)^ Again, 
the force component along (Sj)-^ i& determined by the task geometry to- be 0 T but 
the component along Sf is determined by neither the natural constraints ttor the 
goal trajectory. The magnitudes of the forces normal to the surfaces of this 
simple model are irrelevant to the satisfaction of the goal trajectory, so any 
values will do. 1 We may choose the artificial force constraints to be an 
orthogonal vector flat {{S f )Kf) with f^Sp but t is not completely detcrmined- 
Any particular value of f will work for a rercKuefjy surface. 


1, Since this is clearly not true in the real world, some explanation may be 
helpful The zeroenergy domain abstracts away some properties of manipulators 
such ai actuator torque limits, and properties of task configurations such as limits 
on how much force can be applied without upsetting the task* so that force 
magnitudes become unimportant. Upsetting the task configuration is a problem 
which will be addressed in later sections of this chapter, but considerations which 
depend on the particular manipulator are better left our of the ideal domain, and; 
will not be considered until the nest chapter. 
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So the artificial constraints determine the component of velocity along S T 
and the component of force along S f . For the configuration of figure 2.1* these 
considerations lead us to the artificial constraints 

f * = 0 t x = 0 

f y " 0 '^0 

v z = k ) w, = k 2 

where kj r de l*nd on the goal trajectory, and may vary with time. In this 
particular case, force values of zero were used.-*- 

2.3 Non-Jfonicgeii'ecHiS Surfaces 

The definition of zero-energy surface constraints allows an asymmetry 
between the artificial and natural constraints — the artificial constraints are not 
required to he homogeneous. There is no reason not to allow similar generality 
in the natural velocity constraints, Jn fact, such a generalization will extend the 
scope of our analysis considerably. A nott-homogeneous surface is defined to be a 
surface giving a set of natural constraints which may be noii-homogeneous. Tht 
nan-homogeneous surfaces include the iero-cnergy surfaces-. 

Recall that for zero-energy surfaces the natural Constraints may be 
represented by the vector Suhspaces and K f containing the possible effector 
velocities and forces respectively. For non-homogencous surfaces the same role is 


1. The magnitudes might also be left indeterminate in the artificial force 
constraints* to be resolved when the artificial constraints are transformed into a 
real-world control strategy. Such a technique might be useful in a planning 
system or in manipulator-independent programming- The planning system might 
specify only those aspects of the effector’s behavior which are relevant to the 
task* and allow other aspects to be resolved later with reference to the particular 
manipulator. 
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played by tKe vector flats (S^,Vq) and with Tq g S^, f^. £ Sj-k As with 

zero-energy surfaces, S v and Sf are orthogonal complements. The artificial 
constraints arc unchanged in form* and we will still choose the velocity 
Constraints to bo the unique orthogonal set satisfying the goal trajectory. 
Likewise, the artificial force constraints will be chosen to be orthogonal to the 
natural force constraints, with the force magnitudes still not determined uniquely 
by the goal trajectory. 

An example of the use of non-homogeneous natural velocity constraints is 
the problem of interaction between a manipulator and a moving belt on an 
assembly line. For instance, if the manipulator were to insert a peg in a mowing 
hole (see figure 2,5} then the natural constraints would be 


v x ’ v belt 




w x = E> 
w v “ 0 
T z = 0 


where the belt is moving in the k direction with velocity 
corresponding artificial constraints are 


The 


f, = 0 
fy-0 
v z= k l 


Ty ~ 0 

W, ~ fc' 


which are the same as the artificial constraints obtained for a stationary 
peg-in-hole in section 2,2, The motion along the x-axis is taken care of by the 
force Constraint along the s-axis. This constraint forces the peg to follow the 
hole whether stationary or moving. 
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Fi^ure 2.5. Compliance with Moving Belt. 


The symmetry between natural and artificial constraints is complete for 
non-homogenmus surfaces, and there is noihing but viewpoint to distinguish 
between an arm control system and a task geometry. This unification allows an 
immediate extension to tasks involving multiple effectors. 

2.4 Multiple Effectors 

There is more than one way to develop controls for multiple effectors. The 
first method we wilt present is based on a generalization of the notion of 
orthogonal complement, and resembles previous use of force control for 
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coordinated use of multiple manipulators ([Na]?ano74j, [lshida77]). A set of 
vector subspaces of F^ are orthogonal-complementary if their direct sum is R^ and 
if they are mutually orthogonal. Several manipulators may be coordinated by 
choosing the artificial constraint sets so tHat+ taken with the natural constraint 
set, they form an orthogonataatiplementary set. 


Consider the two-dimensional example illustrated in figure 2,6, In this 
example, two effectors, A and B, are rigidly attached to the beam, O. Viewing 
the task first from A T s viewpoint, if there are no natural velocity constraints on 
O, then the space spanned by the x, y, and 0 axes is the subspace of possible 
velocities, and the artificial constraints at effector A may be three velocity 
constraints. Now if we view the configuration from effector B, the set of natural 
velocity constraints Corresponds to the original natural velocity constraints plus 
the artificial velocity constraints of effector A. So, from B T s viewpoint, the. 
subspace of possible velocities is just the Ovector, and the artificial constraints at 
R must be three force constraints. Clearly, the roles of A and B may be 
switched. It is also possible to use velocity constraints at A along the x-axis and 
at B along the other two axes, or any other suitable mixture. However, all of 





« r ———► -— r -—-► 


Figure 2.6, Multiple F,ffeclor Task. 














- n - 


these possibilities produce asymmetry in [he behavior of the effectors. This is of 
no consequence in the ideal domain, but the effects are observable in the real 
world, where I he manipulator* would react differently to unexpected disturbances. 


A more appealing approach exists which is symmetric with respect to the 
rotes of tiie two effectors, First, we find the natural constraints. The rigid, 
attachment between the object O and the manipulators A and B gives the 
following identities between velocities. 


v Ak = *0* 
v Bk = 'Ox 
V A0 = v O& 


v m = v o& 

' Ay + v By 


^Oy 


v By - v Av 

r 


= 'W 


If we assume that the only forces acting on effector A or B are the result of 
contact with O, then by balancing forces and moments we have 


f Ax + f Bx “ f 0x 
f Ay + f By = foy 


1 f 1 ’ fA r 4 


f A0 + f B& = 


So far we have nine equations, obtained strictly from consideration of the 
interconnections of the manipulators and the object. An additional three 
equations will result from, the interaction of O with the task geometry. By 
leaving these exiernai constraints unspecified, the results we obtain will be 
applicable independent of the external task configuration. Some manipulation of 
the nine natural Constraints gives us: 
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'Ax ‘ v Bx = 0 
V A ff ■ V BJ? = 0 


(223) 

(2,2b) 



(2.2c) 


and 


'A* = v 0x 
V A0 2 V O0 


(2.3a) 

(22b) 



(2.3c) 

(2.3d) 

(2.3e) 


f Ax + f Bs * [ Ox 
f Ay + f By = f 0y 



(2.3Q 


Equations 2.2 can be viewed as natural constraints on the velocity components of 
the effector pair. Equations 2.3 give us a transformation from velocity and force 
of the object to velocity and force of the effector pair. These can be used to 
transform external constraints on O to constraints on the manipulator pair. 
These transformed constraints, taken with the first three equations (equations 
2.2) r can be treated like any other set of natural constraints. Note that the first 
three* though, are independent of the external constraints on O- They result 
strictly from the geometry finking the effectors together. Hence, we can 
determine three of the artificial constraints independent of the esternal 
constraints on O. They are 


(2,4a) 

(2.4b) 


f Aa' f B* = 0 



(2.4c) 


Again, force values other than zero could be nsed, but zero gives an appealing 





symmetry. The remaining three artificial Constraints depend on the external 
constraints on O t and are determined using the transformations above. For 
example* suppose O is pinned at its center so that only rotations are possible. 
Specifically, the natural constraints on O are 


o 

u 

p 

(2,5a) 

v Oy = 0 

(2.5 b) 

f O0 

(2.5c) 


Applying (he transformations {equations 2,3) we obtain natural constraints on A 
anti 13. 


v Ak = 0 

(2.6 a) 

V A^li = 0 

(2.6b) 

2 " V r Y + [ A$ + f B(? 3 0 

(26c) 

The corresponding artificial consents are 

f A„=° 

(2.7a) 

-Ay * f By _ Q 

(2.7b) 

, v Bv " v Av 

2 r + v Ati + V D0 = k 

(2.7c) 

where k is determined by the goal trajectory. 

The final set of artificial 


constraints is the conjunction of equations 2,4 and 2.7. A little cleaning up 
yields: 
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fA«=° 

(2.8a) 

fB>=0 

(2,8b) 

f Ay + f By * 0 

(28c) 

f A0 ' f B0 " 0 

(2.Bd) 

f Bv ’ f Ay c - n 
— ■ f A0^° 

(2.8e) 

2 — 1 + V A0 + V B0 k 

(2-W 


These constraints prevent compression or torsion of the bar linking the two 
effectors, they prevent any component of force at the pin in the x-y plane, and 
provide for compliant rotation of the bar about the pin. 

This demonstrates how to transform a set of task constraints and a linking 
geometry into constraints for multiple effectors. We obtain, two sets of natural 
constraints, one set due to the geometry connecting the effectors, and one set 
transformed from the externa] task constraints. The corresponding sets of 
artificial constraints play different roles in the resulting system. The artificial 
constraints obtained from the connecting geometry are used to determine the 
'’inode" of cooperation of the effectors. In the example, they provide for 
symmetry, prohibiting any opposition between the manipulators. The artificial 
constraints obtained from ihe external constraints art used to obtain the desired 
external function. 

2,5 Half-Surfaces 

A simple example of a task not directly modeled by an ideal surface was 
shown in figure 2.4. In this example the peg Is at the bottom of a hole, and may 
move upward along the z-axis, hut not downward, This gives rise to constraints 
expressed not as equations but as inequalities: 
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v z > 0 ( t % 0 

I here are two possible modes of motion possible in this case: withdraw the poijp 
or rotate the peg while maintaining contact with the bottom of the bole. The 
first inode corresponds to traversing the interface between two ideal surfaces of 
differing dimensions. A control strategy to accomplish such motions falls into the 
class of guarded moves (section U), and is not treated in this report. It is tbe 
second mode which interests us. In order to apply the analysis of preceding 
sections, we use as a nattrral constraint 

v z - 0 

and as the corresponding artificial constraint 

In previous sections, the value of t was irrelevant, but this is no longer so, )n 
order to obtain a consistent set of force constraints* < must be non-positive. In 
practice, a small negative value for e, a small bias force, should be used to allow 
for error in the control system. 

The result is that the ambiguity introduced at a half-surface may be 
resolved by examining the goal trajectory. If the trajectory moves away from the 
half-surface, ihe motion must be initiated using a guarded move. If the 
trajectory lies along the half-surface, we can pretend it is a "full" surface, as long 
as we guarantee continued contact by using a bias force. 

For temple, consider the task shown In figure 2.7* and suppose the goat 
trajectory specifies motion along the surface. The natural constraints art 
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Figure 2.7. Two Dimensional Surface. 


v x = 0 

f y ”0 

h = ® 

and the artificial constraints will tie 


Vy= ^ 

v *r h 


( 2 .%) 

{23c) 


(2.10a) 

(2.10b) 

(2.10c) 


where e is 2 small positive bias force and kj, k2 are determined by the goal 
trajectory. This trick of making assumptions to change the natural constraints 
from inequalities into equations, and then using the effector program to guard the 
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assumptions, will also be used in the ne*t section to handle sliding Friction, 

2.6 Force Thresholds 

A half-surface gives rise to m ambiguity — we have the freedom to treat it 
as a surface or not, as we choose. Sliding friction produces a similar phenomenon 
by virtue of its threshold nature. A common model for sliding friction 
[Simunnvic75J is given hy 


f t - f 0 ]5[ N > o 


|f|| i Fq otherwise 


where f f is the force Component along the surface tangent, v is the velocity 
vector, and fg is the force threshold, (q is sometimes the product of the normal 
force and the coefficient of friction. 

This type of constraint can be treated in a fashion similar to that used for 
half-surfaces, In this case, the choice of model depends on whether or not 
motion relative to the surface is specified by the goal trajectory, and the 
assumptions can be guarded by choosing cither a non-zero velocity or a forte 
with magnitude less than In contrast to the situation with half-surfaces, both 
modes are readily described by ideal Surfaces. Returning to the example of figure 
2-7, suppose the coefficient of friction of the surface is ^ Then the new natural 
constraints are 



(2.1 la) 


(2.11b) 

(2.He) 


if Vy. is non zero, or 
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( 2 . 12 a) 

(2.12b) 

( 2 . 12 c) 


v x-° 

* f* f* 
f e = 0 

if Vy = 0. If the goal irajiectory specifies motion upward along the surface, then 
the artificial constraints will be precisely the same as in the section 2.5, equations 
2.10. On the other hand, if the goal trajectory specifies a velocity of zero along 
the y-axis, then the artificial constraints will be 

f s - t (213a) 

f v - 0 <2-l3b) 

V 0 = k (2-13c) 

where e is a bias force chosen as in section 2.6. As for a half-surface, the 
ambiguity can be resolved to satisfy the goal trajectory. The alternatives For the 
example are represented in table form below. 


Motion 

Natural 

Artificial 

Desired 

Constraints 

Constraints 



fjt * * 

Vy 4 0 


Vy - I] 


o 

ii 

C& 

V $ = H 


o 

11 

W 

P 


Vy = 0 

tyl S *■ f. 

f y =° 


fe=® 

< 

II 

K* 


The use of force threshold constraints may also he a convenient way to prevent 
excessive forces which might upset the task configuration. 
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21 Tangential Forces 

The friction example of the previous section exhibited components of force 
along the surface tangent. Masses and springs also give rise to forces along 
surface tangents. The resulting natural constraints can be extremely complicated. 
Fortunately, some surfaces have the useful property that the normal forces are 
unconstrained, and in particular do not depend on the tangential forces. If this a 
the case the artificial constraints may be selected as before with assurance of 
consistency with the natural constraints, and the complicated nature of the 
tangential natural constraints may be ignored. 

Suppose that we are given a set of natural velocity constraints, and suppose 
that the artificial velocity constraints art chosen to be perpendicular to the 
natural velocity constraints, and the artificial force constraints are parallel to* the 
natural velocity constraints. Clearly the combined velocity constraints are 
non-singular. Likewise, if normal Forces are not naturally constrained the 
combined force constraints will be consistent and independent. 

For example, consider the task shown in figure 2JL In this example, a 
two-dimensional bead a constrained to move along a wire. The natural 
constraints are 

v y =0 
v fl ^ 0 

f * =m iJt v K 

where m is the bead's mass, a constant.. This example satisfies the crucial 
assumption — there 1$ no constraint on forces along the y-axis or 0-axis, 
Accordingly, the artificial constraints of the form 
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Figure 2.S. Bead on Wire, 





(where, as usual, k may be a function of time) are non-singular. 


In general, determining the natural constraints may not be possible. 
However, the upshot of this section is that the natural force constraints need not 
be determined, as long as we may assume that there is no natural constraint on 
the norma) force. The artificial constraints may be chosen solely on the basis of 
the natural velocity constraints. The details of the relation between forces and 
the position trajectory along the surface tangent will not come up until we get to 
implementation of real‘world control strategies (section 3.2), 

The critical assumption of unconstrained normal force is valid for a broad 
range of task configurations. An example violating this assumption is the sliding 
friction example of the previous section, where normal force was constrained 
by the equation 
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~ * f * 1 ^ 

Another interesting example which violates the assumption is a spinning top^ 
which transforms a force a3ong one a*i$ into a velocity along an Orthogonal ajtis. 
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3, Transformations 

3.1 From Real- World Tasks to Natural Constraints 

Many as|?ec!s of the transformation from rtal-wOrld tasks to natural 
constraints were suggested in the previous chapter. In partieslar t natural 
constraints for surfaces, friction, masses, and springs were developed. Rather 
than belabor these aspects of task configuration, we will proceed to consider 
objects with positive physical dimensions (section 3.1.1) and time-varying 
constraints (section 3,1.2). 

3.1.1 Dealing with Objects of Positive Extent 

1 be meihods of the previous chapter require that the task be represented as 
const rain is on l he velocity of the ideal effector, which has no physical 
dimensions. The real world is composed of objects for which the physical 
constraints are distributed in space. Before applying the ideal effector methods, 
if will bo necessary to collect these constraints, at a single point. 

The approach described here follows a common approach to the analysis 
and synthesis of mechanical linkages [Martenhurg64]. Let us assume we have the 
task represented as a set of rigid bodies, links, which are connected to one 
another hy one. of the lower pairs, exhibited in figure 3.1, The contacting 
surfaces of the two links of a pair are called the elements of the pair, A pair 
imposes a Constraint on the relative velocity between the elements of the pair. In 
fact, the relative velocity Is constrained to lie in a vector subspace. For example, 
the screw pair gives the following constraints. 


Revofute 
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Planar 



^--* 





FifiWf 3,1. Lower Pairs. 
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¥ 


z 



= "it " ^ 


0 


where Tp^- (v, v y v z w s w y is the relative velocity of the pair (tht 
difference between the velocities of the pair elements)* and L is the lead of the 
screw* the advance per revolution. 


The natural const rainta in the ideal domain for a task consisting of links 
connected by pairs may be determined by propagating velocity constraints to a 
common point at the effector, Tht propagation of constraints is handled by two 
operations; translation along links, and passing through pairs. For translation of 
velocity constraints along links* let us assume that A and B are two points rigidly 
attached to a link- If and are the velocity subspaees for points A and B 
respectively! ihen Sy. is the image of 5^ under the linear transformation T, 

% = T(S a ) 


where T is represented in matrii form by 


T = 


h 


0 VR,\ 

1 R z 0 R , 

i R y -R* 0 


\ 0 I ’3 / 

where R = (R x R y R z ) is a 3-vector from point A to point B. 


Passing constraints through a pair is slightly more difficult. If the velocity 
constraints for one element of a pair are known, and if the relative velocity 
constraints for the pair are known, we can determine the resulting velocity 
constraints for the second element of the pair. If the relative velocity constraint 
subspacc is Sp+ and the velocity constraint space of element A is S^* we have 





- 46 - 


( *B ' t A> e % 
t A^a 

and the resulting constraint on ? B is 

t B e S F © 

where S p © S A consists of all vectors which may be expressed as the sunt of a 
vector from Sp and a vector from 

Using these operations the velocity constraints may be transformed to a 
common point, If two different constraint sets are obtained at a single point, the 
corresponding velocity suhspace is obtained by intersecting the two original 
sub-spaces. Accordingly, the method proposed is to trace every chain oflinks and 
pairs from "ground 1 ' (presumably the workbench) to the effector. The 
intersection of the resulting subspaces gives the appropriate velocity constraint for 
the effector, As an example, consider the task configuration of figure 3,2. The 
constraint at A allows translation along the x-axls and rotation about the z-axj$, 
while the constraint at B allows translation along the y^axis and rotation about 
the i-aiis. We wish to find the velocity constraints on point P, If O is assumed 
motionless, then we have at A: 

v Ay =0 
v Ai " 0 
“Ax =0 
“Ay 85 0 


and at B 


A1 



Figure 3.2. Example of Velocity Constraint DetermifUrt»fl< 


v Ds = 0 
v Bl -0 

w Bs = 0 
‘■'By “0 

Letting and Rg be the ^vectors from A to F and from B to P, 

R a = <2 cos(^), 2 sin{0) a 0) T 
Rg = (cos($), sm(£), 0) T 

the appropriate linear transfer tnatiofii and Tg are 
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0 -2 

0 1 cos(0) 

-2 cos($) 0 

1 I 

J 

0 -mq£$) 

0 ws(0) 

-cos(^) o 

_ 

Now S A is spanned by the vectors 1] =(10000 0) T and I 6 = (0 0 0 0 0 1) T 
and S B is spanned by l 3 - (0 1 00 0 0) T and So S p is obtained by 
intersection of the space spanned by T a 0j) and T A (I 6 ) with the space spanned 
by 1 b(* 2^ and j b( 1 6)' Restated as vector equations we have 

** m *l*AW + h*AW 
V P ^ k 3 + h T BW 

Expanding these into scalar equation; and eliminating the unwanted variables, we 
finally obtain 

v F3( * = 0 

v Py - 2 cos(0) wp E - 0 

T Pi“<* 
u Fy = 0 

which are the natural velocity constraints for the point P, 

Unfortunately, not all task configurations art as easily modeled as this one. 
The problem is that the relative velocity constraints introduced at a pair depend 
on the orientation of the pair. This in turn may depend on the relative positions 
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of any number of pairs in the mechanism. Hence application of this method 
must in general be preceded by a positional analysis of the task. There is no 
general algebraic method of kinematic analysis available, although methods exist 
for various special classes of mechanisms (for example see |[IMfy74]K If 
numerical methods are considered, the situation is somewhat improved [Uicker64], 

31,2 Time-Varying Constraints 

In order for a control strategy to be useful, its builtdn assumptions of state 
should hold for some reasonable amount of time. For some tasks, the natural 
constraints are constant; for others they vary with time,, either because the task 
surface is in motion, or because the manipulator is moving on the surface. Since 
the artificial constraints are orthogonal to the natural constraints, the artificial 
constraints will also be fund Eons of manipulator position and time.. 

As an example, consider the door-closing problem in two dimensions. 
Figure 3.3 illustrates the problem. The effector is rigidly attached to the 
doorknob. If we assume any friction is negligible, the natural constraints at the 
instant shown are 

v* = ° 

v v - R Va - 0 

fy + *f<>=0 

Unfortunately, the instant the door moves, the natural constraints will change. 
In this case, the natural constraints are easily expressed as a function of Bq, the 
angle the door makes with the horizontal Specifically, 
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Figure 3,3, Door Closing Problem. 


eos( ffo) v K + sin( %j) v y = 0 (31a) 

-&in(%,) v K + «K{St)> v y -R v e = 0 (3.1b) 

**“■<%) f x + COS(0 D ) f y + ^ U ~ 0 (51C) 

The artificial constraints may also be expressed m terms of 0^, obtaining a single 
set of artificial constraints which is appropriate for any state of the door, 

A simple method For specifying a similar control strategy is obtained by 
observing that the natural constraints as measured in the coordinate frame of the 
effector are constant. So the artificial Constraints wilt also be constant in the 
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effector frame [Paul7&], If the effector frame is initially aliened with the 
external coordinate frame then the artificial constraints are 


(3,2a) 

(3.2b) 

(3.2c) 


f * = ° 

ty -Rf^=0 




artificial constraints are expressed in terms of 0 q, a method for determining 0p 
is needed. There are three reasonable alternatives: 


Use the. planned value for computed from the goal 
trajectory. 

Compute from the actual manipulator's z-rotation in 
real time. 

Compute (fo from the manipulator's position in the x-y 
plane in real time. 


Since the manipulator will undoubtedly stray slightly from the planned trajectory, 
these three methods will give different results. Usually the first method is best, 
because it leads naturally to trajectories satisfying the goal as formulated in 
section 1-4- However, if the information on the door is incomplete, and large 
trajectory errors are possible,, one of the latter two methods would be preferable. 


1. To be precise, the velocities are measured in an external frame and 
transformed to the effector frame. If they were measured directly in the effector 
frame, the effector velocities would always be zero. 



3.2 From Artificial Constraints into Control Strategies 

The last step in the synthesis of control strategies is the transformation 
from artificial constraints to real-world control strategies. Since the ideal effector 
Corresponds to the end-effector in the real world, the artificial constraints are 
interpreted as equations to be satisfied by (he end-effector, The role of 
equation enforcer 1 ' can be performed by a system which resembles control 
systems already in use [FaulTG, Shimano77j. This section is primarily concerned 

with the design of such control systems, which leads into a discussion of error in 
the real world,. 


The problems of low-level control of manipulators are very complex. A 
detailed description of a low-level control system capable of enforcing artificial 
constraints is beyond the scope of this report, Nonetheless, success of the 
methodology developed in the preceding sections depends on the prospects of such 
a. control system, While it is clear that the artificial constraints will produce the 
goal trajectory in the ideal domain, it is critical that they work in the real world, 

The nature of an implementation must be considered to properly assess this 
question. 


There are three fundamental problems of classical mechanics which have 
been solved for many research laboratory manipulators. They are: 

Kinematics. Given the position of the end effector in 
cartesian, coordinates, determine the corresponding 
manipulator joint positions, 

Sttitfcs. Given the force exerted by the effector of the 
manipulator, determine the corresponding forces developed 
at the manipulator joint actuators, 
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Dynamics, Given the position, velocity* and acceleration of 
each manipulator link., determine the corresponding fortes 
developed at the manipulator joint actuators. 

A solution to the first problem enables a System to transform a goal trajectory 
defined in cartesian space to a trajectory in joint space. Analytic solutions for 
this problem are known for most research arms JPieperfjS, Faul72, Hom74], The 
solution to the second problem is the simplest, because the transformation from 
forces in cariesian space to forces in joint space is linear, if f c is a vector of 
forces in cartesian spate, and fj is a vector of forces in joint space, then wt have 

fj = Ff t 

where F is the force resolution matrix. It so happens that the force resolution 
matrix bears a simple relation to the solution to the kinematic problem. The 
Jacobian is a matrix whose i-jlh entry is the partial derivative of the ijfe cartesian 
position coordinate with respect to the jth joint position variable. 

dx = J AB 

where dx is the differential cartesian position vector* d& is the differential joint 
position vector, and J is the Jacobian. The force resolution matrix is just the 
transpose of the Jacobian matrix [Groome72]. 

F = J T 

The solution lo the dynamic problem is more complicated. [Kahn69, Paul72, 
Bejczy74, Horn?5], Allhough sophisticated dynamic models are available* most 
control systems are based tm simplified models of the dynamics. 
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Given solutions to the three problems outlined above, an open-loop control 
system could be constructed as in figure 3,4. The control system translates the 
goai trajectory from Cartesian coordinates to joint coordinates by inverting the 
kinematic equations. The static equations are used to derive actuator torques 
from the effector forces. To these arc added the actuator torques obtained from 
the joint motions using the dynamic equations- The resulting torques would be 
applied at the appropriate actuators. This system worlu precisely the same 
whether force control or position control is desired. The two different Control 
inodes arc only distinguished in the manner in which feedback is used. 

The open-loop method is not generally used due to the presence of error. 
The planning model cannot represent the real task with complete accuracy- The 
static and dynamic equations arc also inaccurate. 1 The use of sensory feedback 



Figure 5.4. Open Loop Manipulator Control System. 


1, Most control Systems use very simple dynamic models. [Raibert77J and 
[Horn77b| describe a control method using a "better dynamic model, but in any 
case error will still be a factor. 
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compensates for the inaccuracies of the task and manipulator models. However, 
when the loop is closed the force and position control systems are no longer 
identical. For one thing, a closed loop force control system would naturally 
require force sensors, while a position control system would require position 
sensors. For a hybrid system, combining force control of some axes with position 
control of other axes, both position and force error must be determined. 
However, the position error is reckoned only along the position axes* and the 
force error only along the force axes. In the language of the ideal domain, the 
force error is projected onto the planned surface normal space* and the position 
error is projected onifl the planned surface tangent space. The resulting 
calculated error is the distance from the artificial constraint spaces, as it should 
be. Mote that the planned surface is used For the error projections, consistent 
with the definition of the goal trajectory (section 1.4). 

The calculations required for the implementation described above are very 
time-consuming. Some of these calculations may be avoided using the fr$e joint 
method [Fau!72, Paul?6, and Shimano77j, This apjiroach is easily grasped by 
considering a task with the properly that each force or velocity constraint 
happens to be aligned with a manipulator joint. 1 In that case, the force axes can 
be servoed on force and the position axes on position in an independent fashion, 
which is precisely the method used in [InoueTl] and [Silver?3], Even if the joints 
are only approximately aligned with the desired constraints, good results may still 
be obtained. Based on this observation, the control system in. \ Paul?2) accepts 
arbitrarily oriented force constraints am) approximates them by constraints 


l. The alignment of manipulator joints with natural constraints might occur 
surprisingly often, since most assemblies require compliant motions along one of 
only a few possible lines of approach [Nevin&TTj, Hence a manijyulator might be 
used with its joints aligned with these lines of approach. 
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aligned villa manipulator joints. The constraints, and joints are matched by using 
the force resolution matrix to find the joint most sensitive in the direction of the 
constraint. The corresponding actuator torque it held constant without regard 
for any normal forces contributed by the other manipulator joints, Similarly, the 
position axes are servoed without regard for tangential motions contributed by 
free joints. The resulting errors limit the usefulness of the system. 

These problems were remedied in [Fau|7&J. Forces due to posit ton-servoed 
joints are automatically accounted for by using force sensors to read the actual 
forces at the effector. Tangential motions due to free joints are calculated and 
used in the position servos. [Shimano77] describes an implementation of a similar 
system. Neither of these scheme* will accept a force constraint which includes 
components of torque and force, such as the constraint 

fy - R f tf -0 

obtained in section 3,1.2 for the door-dosing example. Also, neither system 
projects the goal trajectory using planning surface normals in all circumstances, 
although these differences could probably be eliminated without too much 
difficulty. 
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4, Conclusions 
4.1 Discussion 

The primary goal of this work was to develop a. method for synthesiiing 
control strategies for compliant motion, using a precise language to describe force 
control- To that end, the formal models for surface, manipulator, and control 
strategy were defined., and a precise formulation of goal trajectory obtained. The 
synthesis problem is considerably simpler for these abstract objects, and the 
control strategies obtained are appropriate for many compliant motion tasks in 
the re nil world. The most important aspects of this method are the 

representations of surface and manipulator, The use of sub-manifolds of tO 1 

represent surfaces focuses directly on the most important characteristic of a 

compliant motion task — the degrees of freedom of the manipulator. The 

unified treatment of rotational and translational variables led to- the synthesis, of 
control strategies which couple rotation and translation of the manipulator 
effector, an aspect of compliance which was previously neglected. The precise 
formulation of goal trajectory and the associated criteria for the manipulator 
trajectory (i.c. the projection of the goal trajectory along planning surface 
normals) has riot been discussed in substance previously, although the desirability 
of some such projection property is mentioned in an example in [Paul76], 

The use of artificial constraints orthogonal to the natural constraints is an 
important aspect of the synthesis method. For velocity constraint, this is the 
only choice that will produce a trajectory satisfying the goal trajectory criterion 
(section 1,4), The value of orthogonal force constraints is illustrated in figure 
4.1, The planning model forte constraint is represented by a solid line, the 
real-world force constraint by a dashed tine, The orthogonal artificial constraint, 
pictured on the left, gives much better results than the artificial constraint 



Figure 4.1. Comparison of Orthogonal and Non-OrthogonaL Force Constraints. 
I He effect of an error in the planned natural force constraints is compared for an 
orthogonal artificial constant (left) and a non-orfhogonal artificial constraint 
(right). 


pictured on the right, if bounds for the normal force were determined in the 
planning stage, the non-orthogonal artificial force constraint might result in a 
force violating the bounds, thereby losing surface contact or upsetting the task. 































- 39 * 


An interesting question arises in connection with the representation of ideal 
surfaces — given an arbitrary ideal surface, is there a corresponding task 
configuration realizable in the real world. The answer is yes, because the 
transformation from artificial Constraints to real-world control strategies is a 
method for constructing a physical realisation for an arbitrary ideal surface. In 
this sense, one can think of the manipulator as a programmable ideal surface., In 
the vicinity of the effector position the planning surface and '’manipulator 
surface” will have exactly one common (.mint. The two surfaces are Orthogonal 
at this point, and the position of this intersection (as a function of time) is the 
goal trajectory. The real trajectory will be the intersection of the real task 
surface with the manipulator surface. The projection property is a simple 
consequence of the use of a manipulator surface which is orthogonal to the 
planning surface. In this view of compliant motion, force control is just a 
manipulator surface, and the control Strategy Synthesis method says simply to use 
a manipulator surface which is orthogonal-complementary to the planning surface. 

The ideal effector has potential applications in other areas of manipulation, 
ft is- used implicitly in previous task planning systems {particularly [UdnpaT7J, 
[LozannTSD, and seems to be a good way to develop manipulator-independent 
programs. Much of the planning process can be decomposed into a stage 
concerned primarily with task level planning in terms of the ideal effector, and a 
stage to interpret an idea! effector program using some particular real-world 
manipulator The ideal effector can also model objects in the environment other 
than the manipulator end-effector. In fact, in this report the ideal effector was 
often identified with some geometrical solid which was not a manipulator. This 
generality is important for planning purposes, for the desired Compliant motion 
often does not involve the end effector directly, but rather an object grasped by 
the effector. 
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It must be emphasized that there art other types of control strategies which 
might be m&ed for compliant motion. Two in particular are the generalized spring 
and the generalized damper methods. In the general] red spring method, the 
control strategy enforces the relation 

f = K <P - Pq) 

where f is the effector force, p is the effector position, and p Q » the nominal 
position, which is input supplied from the planning system or user program. K is 
the stiffness matrix, which relates forces observed at the effector to deviations 
from the nominal position. The stiffness matrix can be chosen to optimize 
performance of a particular task, this approach was pursued at the Draper Lab 
and culminated in a mechanical implementation capable of extremely fast peg 
insertions. 

The generalized damper method is similar in form. The control strategy 
enforces the relation 

f - B (t - vqJ 

where J is the effector force + f is the effector velocity, and vq h the nominal 
velocity, which U input from the planning system or user program. B is the 
damping matrix, in this case relating effector force to deviations from the 
nominal velocity. A generally useful choice for B is just the identity matrix 
times some negative damping coefficient. Other choices may exhibit interesting 
properties. For instance, it is possible to choose B so that the manipulator will 
climb over any obstacles it encounters. Many early force compliance schemes 
iGroornc72, Silver?J] are conveniently viewed as damping schemes. Both the 
generalized spring and damper methods are discussed in [Nevin*74a] and the 
generalized damper is discussed further in IWhUneyTGj. We could also define a 
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generalized inertia control strategy, which would be a convenient model for the 
free-joint method of force control 

These control strategies (when a reasonable stiffness or damping matrix is 
used) have the advantage of being consistent with almost any naturally occurring 
set of natural const rain Is. However, their effect is more difficult to model than 
the ideal surface strategies presented in this report. For this reason, they are not 
as convenient from the planning point of view. From the implementation point 
of view, though, these models are indispensable. For instance, an implementation 
of an ideal surface strategy might look like a generalized spring with the position 
axes very stiff and the force axes very loose. 

4.2 Suggestions for Further Work 

This report touches on many aspects of manipulation, so many of the ideas 
and problems have been only partially developed- The control strategies 
developed were not compared in any precise sense with other strategies for 
Compliance, the generalized spring and damper methods in particular. Likewise 
the design choice restricting artificial constraints to be orthogonal to the natural 
constraints was only addressed superficially in the report. This is particularly 
interesting, since many of the published examples of Compliance programs 
correspond to a set of OfflHJrthpgonal constraints. 

Integrating the control strategy synthesis technique info a complete planning 
system is an interesting problem, A trajectory traversing several surfaces might 
be decomposed into several segments, each lying in a. single surface. The 
transition from one surface to another requires a guarded-move, type of control 
strategy. The synthesis of guarded-move type strategies for the interface between 
t^o surfaces is an interesting problem in its own right. 
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The report emphasizes the use of the ideal domain for synthesizing artificial 
constraints, but it was felt that the chapter nrt transformations between the ideal 
domain and the real world was necessary for logical completeness. The particular 
transformation methods described were meant to play the role of a constructive 
existence proof. A more serious effort on this problem would be justified. 
Velocity analysis of mechanisms has not been neglected in the kinematics 
literature (for example see {Denavit65J), but the current work is focused on single 
deg re e-of-freedom closed kinematic chains, with limited applicability to 
manipulation tasks. 

The difficulty of implementing an active force control scheme should not 
be judged by the scant attention it receives in this report. There are important 
unresolved issues both in hardware and software design. Ultimately any 
compliant motion method will be judged by the velocity achieved without 
exceeding a specified force error, which depends on the frequency characteristics 
of the force control loop. In [Nevins74bj this argument is pursued to suggest the 
use of redundant degrees of freedom to provide compliance. The remote-center 
compliance device [Nevin$77] uses passively compliant redundant degrees of 
freedom. A programmable active compliance is necessary to implement the 
compliant motion primitives developed in this report, but so far no active 
compliance using redundant degrees of freedom has been built. 
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